® 



J 



Europalsches Patentamt 
European Patent Office 
Office europ^en des brevets 



© NumSro de publication: 



0 364 353 

A1 



DEMANDE DE BREVET EUROPEEN 



© Num^ro de d6p8t 89402789,5 
© Date de dSpdt 10.10.89 



© mtciAGOSD 1/03 , G01C 21/00 



© Prlorite: 12.10.88 FR 8813438 

@ Date de publication de la demande: 
18.04.90 Bulletin 90/16 

© Etats contractants ddsign^s: 
DE ES GB IT NL SE 



© Demandeur COMMISSARIAT A L'ENERGIE 
ATOMIQUE 

31/33, rue de la Federation 
F-75015 Parls(FR) 

© Inventeun Detrlche, Jean-Marie 
6 La Galllarderie /> 
F-78590 Noisy Le Rol<FR) 
Inventeun Mlcaelll, Alain 
9 rue Durand Benech 
F-92260 Fontenay Aux Roses(FR) 



© Mandataire: MongnSdlen, AndnS et al 
c/o BREVATOME 25, rue de Ponthleu 
F-75008 Parls(FR) 



© Proc$d$ de mesure de Involution de la position d'un vdhlcule par rapport & une surface. 



© Proc6d6 de mesure de Involution de la position 
d'un vShicule (1) pourvu d'un moyen de prise de 
vues fixe (4). Des vues d'une surface (5) gamie de 
motifs de repSrage (8, 7) spnt prises consScutive- 
ment, et on compare des fragments de vues appar- 
tenant h des parties communes d'images cons£cuti- 
ves pour en dSduire les d^placements du vdhlcule 
d). 
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PROCEDE DE MESURE DE DEVOLUTION DE LA POSITION D'UN VEHICULE PAR RAPPORT A UNE . 

SURFACE 



L'invention se rapporte k un procede de mesu- 
re de revolution de la position d'un vdhicute par 
rapport k une surface. 

Parmi les precedes deja. utilises pour guider un 
vShlcule tel qu'un robot dans un environnement 6 
determine, on peut signaler ceux qui consistent k 
repe>er au moyen de barrettes de capteurs le 
passage du vShicule devant des lignes de gradua- 
tion verticaies peintes sur un mur, k comparer une 
image prise par un moyen de prise de vues k une io 
Image emmagasfnee dans ta memoire du robot, k 
observer Involution des details de Penvironnement 
en avant du v£hicute au cours de sa marche. et k 
cre*er une Image tridlmensionnelle de I'environne- 
ment par deux cameras orient^ es diffeVemment is 

Le premier proce^de" n^cessite des reperes im- 
muables utilises unlquement k cette fin ; le deuxie- 
me utilise une image memorisee et ne*cessite un 
apprentlssage, ce qui est trop peu souple pour de 
nombreuses applications ; les troisieme et quatrie- 20 
me, qui ndcessltent de puissants moyens de cal- 
cul, sont utilises principalement pour Pevitement 
d'obstacies, la generation automatique de trajectoi- 
res dans un environnement encombre ou non 
structure, c'est-a.-dine muni cTobstacles dont la po- 25 
sitlon peut varier. 

Les precedes connus s'interessent en outre 
ge*n£ralement k la position absolue du v^hlcuie 
dans Penvironnement, ce qui est superflu pour un 
certain nombre cf applications. 30 

On propose d'apres l'invention un procede de 
mesure de Involution de la position d'un ve'hicule 
qui soft utillsabie pour de nombreux types cPenvi- 
ronnement et qui soit simple k mettre en oeuvre 
pour permettre des mesures en temps reel. 35 

Le procede de mesure de Involution de la 
position d'un ve'hicule, muni d'un moyen fixe de 
prise d' images, conforms a. Pinventlon est caracte- 
rise* en ce qu'll consiste k prendre p^riodiquement 
des Images d'une surface gamie de motifs de to 
repeVage, k sdlectionner une parte de chaque ima- 
ge situee k une position determined sur i'image, k 
rechercher sur I'image suivante une partie identi- 
que k la partie se*lectionnee et k dddulre Involution 
de ta position du vdhicule entre les moments oO 45 
les deux Images ont 6\6 prises par comparison 
des positions de la partie seMectionn£e et de la 
partie identique sur ieurs images respectives. 

La surface gamie de motifs de repeVage est 
avantageusement parallete a la surface sur laquelie so 
eVolue le ve*hlcule et peut 6ventuellement dtre 
confondue avec elle. La partie se lectio nn^e des 
Images est en gSneVai situee dans une portion 
desdites images orientee vers le sens de marche 



du v€hicule. 

Suivant une variante du proc£de\ on peut tout 
d'abord rechercher sur I'image suivante non pas la 
totality de la partie s^lectlonn^e de I'image prdce*- 
dente, mais un fragment de celle-ci. Si le fragment 
a pu etre tdentifi^ sur I'image suivante, on examine 
si les alentours du fragment identiffe* et du frag- 
ment seMectionne* sont identiques. Dans la negative, 
on peut selectionner un autre fragment, eventuelle- 
ment plus Stendu, et on recommence PopeVatlon 
de recherche. 

On va maintenant commenter invention plus 
en detail k I'aide des figures sulvantes annexees 
titre illustratff et nullement limi&tif : 

- la figure 1 est une vue schSmatique d'un 
vdhicule equlpe* d'un appareillage permettant la 
mise en oeuvre du procede" et evoluant dans un 
environnement approprie, 

- la figure 2 repnSsente une conception equi- 
valente k celle de la figure 1 , 

- et la figure 3 explicate le precede. 

La figure 1 represente un vehicule robot 1 qui 
se dgplace sur un ptancher (surface devolution) 2 
sur des chenilles 3, des roues ou tout moyen 
connu. Des moteurs permettent de diriger le vdhl- 
cule 1 et des capteurs tels que des odometres ou 
des gyrometres sont census le guider en foumis- 
sant des informations de deplacement k une unite 
de commande qui agit sur les moteurs. 

Comme les indications des capteurs deVivent 
avec le temps, le vehicule 1 est pourvu d'un 
moyen de prise de vues ou d'image tel qu'une 
camera 4. La camera 4 est fixe par rapport au 
vehicule 1 , e'est-a-dire qu'elle est dirig£e dans une 
direction constante par rapport k celui-cl. Sur la 
figure 1, elle est orientee vers un plafond 5, mais 
ce n'est pas obligatotre et eile peut tout aussi bien 
dtre orientee vers une autre surface gamie de 
motifs de reperage suffisants, de preference per- 
pendiculairement a cette surface ou avec une l^ge- 
re obliquite vers le sens de marche du vehicule 1 . 
II est simplement pius pratique que cette surface 
soit sensiblement parallete k la surface devolution 
2 du vehicule 1. 

Les motifs de reperage peuvent prendre des 
formes tres diverses selon les capacity s de visuali- 
sation du moyen de prise d'images. On peut aJnsi 
utiliser tes moyens d^clairage 6 accroches au pla- 
fond 5, ou encore des bandes ou des formes 
quelconques 7 refl^chissantes ou de couleurs diffe"- 
rentes. Aucune regularite. aucune symetrie n'est 
n^cessaire et on peut mdme ad mettre des motifs 
sujets k des evolutions d'aspect, comme on va le 
constater plus loin. 
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La figure 2 montre un exemple de ve*hicule 1 
muni d'une camera 4' orientee vers le plancher 2 
luI-m§mo. La surface devolution du vehicule 1 est 
alors confondue avec la surface gamle de motifs 
de reperage, qui sont ici constituds de carrelages 8 
de couleurs di verses mais qui pourraient de nou- 
veau prendre des formes tres diverses. 

Dans tous les cas, le proceed de mesure de 
revolution de la position du vdhlcule 1, qui permet 
de se passer des informations sujettes k incertitu- 
des des capteurs de emplacement consiste k pren- 
dre pdriodlquemerrt des images de la surface gar- 
nie de motifs de reperage. 

La figure 3 montre deux de ces images prises 
cons^cutivement : une premiere image 9 et une 
deuxieme image 10. Les deux images 9 et 10 sont 
distantes d'un ecart longitudinal AY, d'un dcart 
transversal AX et cfun 3cart angulaire Ad, ces trols 
hearts correspondant respectivement aux ddplace- 
merits longitudinal, de c6t£ et de lacet du vehicule 
1, et el les possedent une parte commune 11 ou 
elles se chevauchent 

Le logiciei deSfinit une parte selection nee 12 
sur la premi&re image 9, normalement vers le sens 
de marche du vehicule 1, et la met en mdmolre. 
Quand la deuxieme image 10 est prise, tl recher- 
che sur celle-ci une parte identique k la partie 
s6lectionnde 12, ce qui est possible puisque les 
images sont prises k des intervalles de temps 
suffisamment rapprochds pour que la partie sSlec- 
tionnSe 12 soit incluse dans la partie commune 1 1 . 

Les positions de la parte seMectionn^e 12 sur 
la premiere image 9 et de la partie identique k la 
partie sdlectionnee sur la deuxieme image 10 sont 
ensuite companies pour en deduire les ecarts AX, 
AY et A6. 

La recherche sur la deuxieme image 10 peut 
e*vldemment ne s'exercer que sur une partie de 
celle-ci ou on s'attend k trouver la parte identique 
k la parte seloctionnee 12 et notamment sa partie 
arrlere. La partie avant de la deuxieme image 10 
est alors utilised pour definir une nouvelle partie 
stflectionnee 13. 

Quand les emplacements du vehicule 1 ont e*te" 
calcules, I'unite* de commando ag'rt sur les moteurs 
pour dinger le vehicule 1 vers un point suivant de 
sa trajectoire ou une nouvelle image sera prise. 
Les capteurs de defacement sont utilises pour 
guider approximativement le vehicule 1 vers ce 
point 

La frequence de prise cTlmages peut Jtre defi- 
nie arbitrairement ou etre regime par le vehicule 1 
lul-m§me en fonction de sa vltesse et du champ de 
vision de la camera 4. 

Plusieurs vaiiantes du precede' sont envisagea- 
bles afin d'accSterer les calculs. On peut ainsi 
rechercher tout d'abord sur la deuxieme image 10 
uniquement un fragment identique k un fragment 



14 de la partie s£lectionn£e 12. Quand Je logiciei 
estime que ce fragment identique a 6t£ trouve, il 
compare les alentours du fragment se*lectionne" 14 
-la position de la parte selectionnde 12 non incluse 

5 dans le fragment sdlectionne* 14- aux alentours du 
fragment identique. Si la comparaison est 
conduante, ('identification est confirmee. Dans le 
cas contraire, il faut admettre qu'il y a eu confusion 
et une nouvelle Identification est tent£e k partie 

to d'un autre fragment 14' de la partie $electionn6e 
12, Sventuellement plus 6tendu que le precedent. II 
en va de mSme si ('Identification n'a pas abouti. 

Celte methods permet de tenir compte de la 
modification 6ventuelle des motifs de repSrage, par 

is exemple cf extinction intern pestive cTune parte des 
moyens d'dclairage 6 : le logiciei constate que la 
parte identified sur la deuxieme image 10 n'est 
pas tout k fait Identique k la partie s£tectionn£e 12, 
mais neglige ces fcg&res differences. a- 

20 Les informations dddultes des images sont uti- 

lises par I'unite* de corn rn and e pour coniger les 
informations des capteurs de emplacement Les 
corrections peuvent etre effectuees soit p£riodlque- 
ment soft quand ridentificatlon des deux images 

2$ conse*cutives a 6t£ tres bonne et ne laisse done 
subsister aucun doute sur les emplacements du 
vehicule 1 entre les moments de prise de ces 
images. 

30 

Revindications 

1. Proc£d6 de mesure de Involution de la 
position d'un vehicule (1) muni d'un moyen de 

35 prise d'images fixes (4, 4) sur une surface devolu- 
tion (2). caractSrise* en ce qu'il consiste k prendre 
pSriodiquement des images (9. 10) d'une surface 
(2, 5) gamie de motifs de reperage (6, 7, 8), a 
sSlectionner une parte (12) de chaque image si- 

40 tude k une position ddtermlnee sur I'image (9), k 
rechercher sur I'image suivante (10) une partie 
Identique k la parte s£lectionn6e (12) et k deduire 
Involution de la position du vehicule (1) entre les 
moments ou les deux images (9, 10) ont 6t& prises 

45 par comparaison des positions de la partie sSlec- 
tionn$e (12) et de la parte Identique k la partie 
selectionnea sur leurs Images respectives. 

2. Proc$d6 de mesure de revolution de la 
position d'un vehicule sulvant la revendicatlon 1, 

so caract6ris$ en ce que la surface devolution (2) du 
vehicule est parallele k la surface (5) gamle de 
motifs de repe>age. 

3. ProcSde de mesure de revolution de la 
position d'un vehicule sulvant la revendicatlon 2, 

66 caracterise* en ce que la surface devolution du 
vShicule est confondue avec la surface garnle de 
motifs de reperage. 

4. Procede* de mesure de revolution de la 
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position d'un vghlcule suivant I'une quelconque des 
revendications 1 a 3, caractdrlsd en ce que la 
partie sSlectionnee (12) de I'image (9) est situ§e 
dans une position de ladite image orient£e vers ie 
sens de marche du v^hicule. 6 

5. Proc6d6 de mesure de Involution de la 
position cTun v^hicule suivant i'une quelconque des 
revendications 1 a 4, caracteris6 en ce qu'on re- 
cherche au prSalable sur I'lmage suivante (10) un 
fragment identique a un fragment (14) de la partie 10 
selecb'onn£e (12). 
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